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Abstract 

'f^'' The design of an invariant tracking control law for the kinematic car driving on a sphere 

is discussed. Using a Lie group framework a left- invariant description on 50(3) is derived. 

^^ ■ Basic geometric considerations allow a direct comparison of the model with the usual planar 

^N I case. Exploiting the Lie group structure an invariant tracking error is defined and a feedback 

H ■ is designed. Finally, one possible design of an invariant asymptotic observer is sketched. 
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The model of the kinematic car, also known as unicycle, is one of the most prominent examples 
in nonlinear control. In the present note it serves as an example for a control system for 
which the associated tracking control problem naturally enjoys relevant symmetry properties, i.e. 
1 ^ , invariance with respect to translation and rotation of the car. In general, symmetry properties 

Cd I are not invariant with respect to feedback. This motivates the design of compatible feedback 

laws, denoted as invariant feedbacks, based on invariant tracking errors as proposed in 5231, I24j. 
For a constructive approach to the computation of invariant tracking errors for systems with Lie 
symmetries see [20] . Closely related to the invariant feedback design is the design of symmetry- 
^ ' preserving observers, see for instance [H [6] , or [7j in particular for systems on Lie groups, 

f— N . For a planar tracking problem, as for the planar motion of the car, a well-known invariant 

On ! tracking error is obtained by expressing the usual tracking error with respect to a moving 

frame attached to the reference or vehicle trajectory, see for instance |281 \TT\ [23] for a mobile 
^J^ ' platform and the kinematic car, or |24l [22] for planar tracking for a rigid body. Other invariant 

-^ ! tracking error candidates can be derived from geometric considerations, see for instance [10] for 

a projection approach. The present note considers the natural extension of the planar tracking 
problem to the spherical case, i.e. a vehicle driving on the surface of a sphere. While related 
problems such as the attitude control of a satellite with two controls modulo the orientation 
along one axis [8], the control of a pointing device on S"^ and tracking on the sphere (without 
^_' orientation) |9] or the attitude control problem of the rigid-body in the fully-actuated case have 

been extensively considered, it seems that the spherical tracking control case for the kinematic 
car on a sphere has yet been overlooked, even though a possible technological application is 
the realization of a non-holonomic spherical joint with two controls allowing for rotation and 
orientation similar to the joints proposed in |26j . Here, the spherical case serves as an instructive 
example in the discussion of the application of invariant feedback designs and its connection to 
structural properties of a given control problem. 

The article is organized as follows. Section [2] recalls the basic formulation of left-invariant 
systems on Lie groups. In Section [3] the planar case is reviewed for later comparison with the 
spherical case, for which the model is derived in Section HI Finally, an invariant feedback design 
for the spherical case and a sketch of an invariant observer is discussed in Section \E\ 
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2 Left-invariant systems on Lie groups 

In this section the class of left-invariant control systems on Lie groups is recalled. Since only 
the invariance property will be exploited in the following, the review is restricted to basic facts. 
Control systems defined on Lie groups have been initially considered by Brockett, Jurdjevic and 
Sussmann in the early 1970s IHEKU], and the reader is referred to the mentioned references for 
a detailed discussion. For motion control and optimal control for this class of control systems 
see [Ul [121 13] , a survey is given in [2S] . For details on Lie group theory and its application to 
differential equations see [271 EH |3] . 

2.1 Lie group and Lie algebra 

An r-parameter Lie group is a group G which is also an r-dimensional smooth manifold in 
such a way that the group multiplication the and inversion are smooth maps. The r group 
parameters play the role of local coordinates for G. Each element g €z G defines a diffeomorphism 
Lg : G ^ G, Lg{h) = gh denoted as left-translation. Let X be a vector field on G, i.e. 
X(g) G TgG, and let (-L^)* : TG — > TG denote the pushforward induced by Lg. A vector field 
X is left-invariant, if it is L^-related to itself, i.e. if {Lg)^X{h) = X{gh) holds for all g,h a G. 
The set of all left-invariant vector fields on G forms a M- vector space g which is called the Lie 
algebra of G. Any left-invariant vector field is uniquely defined by its value at the identity e, 
thus allowing the identification g ~ T^G. Since the dimension of g equals the group dimension 
r and all elements of the Lie algebra are left-invariant vector fields, one can choose a set of r 
vector fields Xi,. . . ,Xr Eg with span{Xi(5(), . . . ,Xr{g)} = TgG for all g & G. 

2.2 Left-invariant systems on Lie groups 

Using the fact that a basis for g yields also a basis for the tangent space TgG smoothly depending 
on the base point g, a left-invariant system with state g a G is introduced as 

m 

g = XQ{g) + Y,UkXk{g), (1) 

fc=i 

with smooth left-invariant vector fields Xk on G and smooth inputs Uk, k = 0, . . . ,m. Due to 
the left-invariance the value of each vector field at g is given by the pushforward of its value in 
e, i.e. Xk{g) = {Lg)^Xk{e). Consequently, the left-invariant system ([1]) can be rewritten as 

5 = (Lg)JXo + ^UfcXfcJ , (2) 

with Xfc(e) =: X^ G g, A; = 0, . . . ,m, and using the fact that the pushforward is a linear map. 
As usual, the vector field Xq is called the drift vector field, and in the case Xq = the system 
is drift-free (or homogeneous [14j). 

In the following, the considered groups SE{2) and 50(3) have matrix representations. Conse- 
quently, tangent vectors are matrices of the same dimension, and in coordinates the pushforward 
of the left-translation Lg is given by g itself. 

3 The kinematic car in the plane 

For the sake of completeness and for later comparison the model of the kinematic car in the 
plane is recalled. Consider the planar motion of a car of length / described by the position y of 
the rear axle midpoint, the steering angle 99, its orientation with respect to some inertial frame 
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Figure 1: Kinematic car in the plane: velocity pole P and osculating circle 

given by the angle 9, and the driving speed v (Figure [1]). Assuming that the wheels roll without 
slipping (i.e. the car does not drift) one obtains the well-known model 
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(3) 



where r denotes the tangent vector to the trajectory of the rear axle midpoint. From a geo- 
metric viewpoint it seems natural to consider an arc length parametrization instead of a time 
parametrization. Let s{t) = J^ v{r])dr] denote the arc length of the curve 1 1— )■ y{t). By using the 
differential relation ds = vdt the system with respect to s reads 
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(4) 



where ' denotes the derivative with respect to the arc length s and k is the curvature of the 
curve. 



3.1 Lie group formulation 

It is well known that the model equations ([3]) are form-invariant with respect to actions of ele- 
ments of SE{2), i.e. translation and rotation, which are symmetries of the model. The symmetry 
property is a natural consequence of the irrelevance of the absolute position and orientation of 
the vehicle for its behaviour. In fact, the motion can be easily interpreted as a left-invariant 
system on SE{2). Hence, the motion of the car in the plane can be described by a smooth curve 
M D / 9 t i-> g{t) G SE{2), or, equivalently, by a differential equation on the Lie group itself. 
Representing an element g € SE{2) as a matrix 
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and choosing three vector fields Xi, i = 1, 2, 3 as basis for the Lie algebra se(2) 
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where e^ denotes the i-th unit vector, and following the spirit of system ([2]) the velocity of the 
car for the chosen nominal configuration g = e is given by 
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Here, the first part describes the rotation around the origin with the angular velocity 9 and the 
second part models the tangential motion. Using the pushforward of the left-translation one 
arrives at a left-invariant model for the planar kinematic car on SE{2): 



9 = 9 9\ 



3.2 Left-invariant tracking error 

Due to the Lie group structure a left-invariant tracking error is obtained by defining the usual 
tracking error in terms of the group multiplication. Let t i— >■ gdit) be a smooth reference trajec- 
tory and define the tracking error by the element ge G SE{2) which is mapped on g{t) by the 
desired position gd{t), 9e = 9^ 9- Note, that this error is also obtained as result of the normaliza- 
tion approach to the construction of invariant tracking errors proposed in [20| based on moving 
frames. Left-invariance with respect to any h £ G is easily observed by ge = (hgd)^^ {hg) = ge- 
The construction of the left-invariant error on SE{2) yields 

Re-ea Rj^iy-Vd) 
1 

with g ~ iy,0), gd — {yd^(^d)- From the first entry of the second column one recovers the 
well-known invariant tracking error given by the usual tracking error y — yd parametrized with 
respect to the moving frame associated with the reference trajectory. 

4 The kinematic car driving on a sphere 

Consider the motion of a car driving on an embedded sphere 

52 = {{yi,y2,yz) G M' | y? + yi + yf - /j' = O} 

of radius p > 0. Assuming that -as shown in Figure [2]- the suspension is designed in such a way 
that the wheels have perpendicular contact with the surface and the rolling without slipping 
condition still holds, at each instant of time there exist great circles through the center points of 
each axle corresponding to the tangent direction of motion in the planar case. Three great circles 
are of particular interest (Figure [2]) : The rear axle great circle (solid line) which corresponds 
to the tangent to the trajectory of the rear axle center j/, the great circle corresponding to the 
horizontal through y on which the rear axle center evolves for = (dashed line), and the front 
axle circle (dash-dotted) corresponding to the tangent to the front axle midpoint's trajectory, 
i.e. the direction of vp in the planar case. As in the planar case, the two rear axle great circles 
enclose an angle 9 describing the relative orientation of the car with respect to the nominal 
orientation, while the rear axle great circle and the front axle great circle enclose the steering 
angle ip. 
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Figure 2: Car rolling on a sphere: front view of an axle (top left), great circles corresponding to 
tangent and horizontal directions in the planar case 

4.1 Left-invariant model on SO (3) 

The position and orientation of the car on the sphere can be uniquely described by a three- 
dimensional rotation matrix g € SO (3) as follows. The matrix g can be interpreted as rotated 
coordinate system with axes r, v, (3, i.e. g = (r, v, f3). Let R{n, a) € 50(3) denote the rotation 
matrix associated with the rotation by a about the unit rotation axis n. Associating the rotated 
y3-axis /3 = ge^, with the position of the rear axle center y, one obtains the corresponding 
rotation Ry by setting Ry = i?(e3 x ^,arccosy3). (For y = pes one sets Ry to the identity 
matrix. An alternative characterization is the rotation associated with the shortest great circle 
segment connecting the north pole with the point y, i.e. the orthodrome connecting the two 
points.) Note that the first and the third column of Ry span the plane which intersects the 
sphere at the great circle for = 0. Performing a second rotation about — hy 6 yields 
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Just as for the planar case the model can be easily derived by using the Lie group approach. 
The Lie algebra of 5*0(3) is given by 



so(3) = span < X{n) 
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where the unit vector n = (rai, 712,713) € M^ defines the axis of rotation for the infinitesimal 
generator X{n). Let g = e denote the nominal configuration of the car, with e = /sxs being 
the identity matrix. In this configuration the rear axle midpoint is located at the north pole of 
the sphere and the car is understood to be oriented as shown on the left of Figure [3l Hence, in 
e the tangent vector of the car is given by 



X{e2)- + X{e3)9, 
P 



(5) 
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Figure 3: Left: top view of the sphere for the nominal configuration g = e; right: geometric 
construction of the length i as funtion of the length I and the sphere radius p 



i.e. the translation in yi-direction at the speed v corresponds to a rotation about the y2-axis at the 
angular velocity -, and the rotation about the rear axle center corresponds to a rotation about 

the ys-axis with the angular rate 0. However, since the surface is not planar but curved with 
constant curvature -, the angular velocity 9 is now obtained from = j tan cp with i = p sin A and 
A denoting the central angle as depicted on the right of Figure [3l Basic geometric considerations 
yield the relation ^ = „. ^ with the radius r of the wheels. Based on equation 1^ a left- 
invariant model for the kinematic car on the sphere reads 



9 = 9 g\e = 9\ X{e2)- + X[e-i)jt?iinp 



(6) 



By construction, this model is left-invariant with respect to any element h G G corresponding 
to translation and rotation in the planar case. 

4.2 Geometric interpretation and differential flatness 

In the context of the previous discussion the axis r, v, f3 oi g have a clear geometric meaning: 
The tangent vector r and the normal vector v span the tangent plane at y to the sphere, 
whereas (3 is constructed as the binormal unit vector. Further, for any given smooth trajectory 
R D I 3 t t-^ y{t) G M^ with v{t) = {y{t), y{t))^ j^ for all t € / on the embedded sphere, i.e. 
(?/) y) = P^i one has 
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Now, let El, £2, S3 denote the usual Frenet-Serret frame of the space curve 
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with K = \\y"\\- In the planar case (JH) the curvature k of the curve s i— > y{s) is controlled by the 
steering angle (p. In the spherical case, the curvature of the space curve consists of the geodesic 



curvature Kn 



tany 



which is controlled by the steering angle and the constant curvature - of 



the sphere's surface. This can be seen as follows: The columns t, u, (3 oi g form an orthonormal 
frame along the space curve s i— )• 2/(s) G R'^. Thus, the second derivative with respect to the arc 
length can be written as 
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v + (y",(3)f3. 



Prom {y' , y' ) = 1 it follows {y" , y') = 0, and using {y, y) = p^ one obtains {y" , y) = 
— {y' , y' ) = —1 and therefore 

y =(y,v)v = Kgi/ . 

P P 

Since /3 points outward, i.e. /3 is the negative of the usually defined surface normal, the projection 
on P yields the negative of the surface curvature -. Comparing this with the definition of 
the curvature k of the space curve one easily obtains k^ = k^ + p~^. Now, from the model 
equations ([6]) one has 

tany _i\^ tanip_ 13 
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9[o ^ -y ==^-^, (8) 

from which Kg is easily identified. For the curve on the surface 5^ this leads to the Frenet-Serret 
equations Vt-t = KgV and Vt^* = —HgT, where V,- denotes the covariant derivative along r, i.e. 
the tangential part of the directional derivative (see for instance [31IIS])- Further, by observation 
of equations (O) (©J and v = :iz\/y'^y it follows that the position of the rear axle center y is 
-just as in the planar case- a flat output of the model. 

5 Invariant tracking control on the sphere 

As for the planar case, symmetry is an intrinsic property of the tracking control problem on the 
sphere. Hence, a feedback design is carried out using an invariant tracking approach assuming 
that only the position y of the rear axle center is measured. One invariant tracking error is 
obtained by using a suitable parametrization of the orthodrome connecting these two points 
on the sphere (Figure |4]) . Defining two angles a and 6 as central angle of the orthodrome and 
relative orientation of the orthodrome with respect to the great circle of the rear axle on the 
reference trajectory, respectively. Note that one can interpret a as contouring error as y moves 
on the desired rear axle great circle with offset a for 6 = 0. (In [9] the angle a is used as distance 
function on 5^ and the tangent direction along the error circle is denoted as "geodesic versor".) 
Similarly, 6 can be interpreted as a misalignment between the current and the desired rear axle 
great circles. Using the embedding, these two angles can be determined by the relations 

{P, (3d) = cos a and (9a) 

( /3 X f3d, i^d ) = cos 6sma . (9b) 

Remark 1 For (3 ^ Pd the usual cross product (3 x (3d yields the axis of rotation of the error 
great circle and also defines the normal vector v on this great circle segment. Hence, this vector 
is an element ofTyS'^ and Ty^S^ . Further, it is invariant under the pushforward along the error 
circle. Therefore, the projection {(3 x (3d, i^d) is defined on Ty^S^. 

In order to avoid singularities for the case f ^ = it is worthwhile to use an arc length 
parametrization for the feedback law. Choosing the arc length Sd{t) = L \\ydiv)\\d'n oi the 
reference trajectory t >—^ yd as independent parameter one obtains the model 

g' = u^ = g(xie2)-+Xie,)^tan^) = g g\, (10) 

considered for 
respect to Sd in equation ([9a|) yields 



with u = — , which is considered for the following feedback design. Taking the derivative with 
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Figure 4: Parametrization of the invariant tracking error by the angles a and 5 



and choosing an error dynamics for a, e.g. a' + Ca(J = 0, Cq- > 0, determines an invariant feedback 
law 
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c^sino-- {P, Td] 
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(11) 



Note that taking the limit /3 — > Pd, i-e. a — )• 0, and t ^ Td and employing L'Hopital's rule, leads 
to u — )• 1 as expected. Differentiating ()9bp with respect to the arc length yields the expressions 



and 



( /3' X /3(i + /3 X (3'^, Ud) + {(3 X f3d, v'^) = a cos a cos 5 — 5' sin 5 sin a 

{(3" X (3d + 2P' X p'a + (3 X p'^, i^d) + 2{(3' X (3d + P X (3'a, ly'd) + {(3 X Pd, v'!, > 
: a" COS a cos 5 — (o"')^ sin u cos 5 — 2a' b' sin 5 cos a — 5" sin (5 sin a — {5')'^ cos 5 sin o" . 



(12) 
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From the model equations one has 
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and thus, using equation ()12p in order to express 5' in terms of a, 6, r, P, v and the reference 
trajectory, and the feedback fi from (jll|) and its derivative /u' for u and u', one can fix an error 
dynamics for 6, e.g. 6" + cj(5' + c^6 = with positive coefficients c], c^, yielding an equation 
that can be locally solved for Kg, or, using Kg = jtamp, for the steering angle (p. Hence, an 
invariant control based on a quasi-static feedback can be derived. Again, taking the limit for 
{t,u,P) — )■ {Tdifd-iPd)-, i-e. {(y,5) -^ 0, leads to Kg — >■ Kg^d via L'Hopital's rule. 

5.1 Observer design 

The resulting control is based on quasi-static feedback of the complete state g ~ iy,d)- If, as 
assumed in the planar case, only y is measured, an estimate for the orientation is required. 



This leads directly to the problem of the design of invariant asymptotic observers as introduced 
in [H [2]. For systems defined on Lie groups a framework for invariant observer design has 
been presented in [IHITJ. However, since most observer designs on SO {3) discuss the attitude 
reconstruction problem for a rigid body based on gyro rate, accelerometer, and magnetometer 
measurements (see for instance [19^ [6]). a possible local design using only the rear axle center 
position for the error injection is sketched at this point. 

Let g denote the observer state. Consider the left-invariant observation error g^. = g^g on 
SO (3). A left-invariant observer may be constructed as a copy of the model equations ([TO]) 
augmented by an invariant error injection, i.e. 



9'=9(9'l + i2^i^9,y)X{e,)] 



with invariant observer gains L^, i = 1,2,3. From this, one obtains the differential equation for 
ge as 

9e = (LgrW + {RgU9^y = g^g' - g^g'g'^g 

/ 3 \ 



9'^ 9 9'\^ + ^U{9,y)X{ei) -fgg'\^g'^g 
\ i=i / 

{9'\^- 9^^ 9'\e9e + '^Li(.9,y)X{ei)\ . 



= 9, 

Note that the observer is parametrized with respect to the arc length of the trajectory for 
y. Hence, one has u = 1 for g'\^. Assuming g^ sufficiently close to the identity ge may be 
parametrized by ge = exp(Xe), Xe G 0. Using the first order approximation ge ^ /sxs + Xe one 
has Xe c^ \{ge — g'^), i.e. close to e the vector field Xe is approximately the skew-symmetric 
component of ge- Consequently, the first-order approximation of the differential equation for Xe 
close to e reads 

3 



X', = Y,Li{g,y)X{ei)-[g'\^,Xe 



i=l 



where all higher order terms in Xe have been neglected and [•,•] denotes the Lie bracket on 
6*^(3, M). Since so(3) can be identified with M^ it is possible to rewrite this matrix differential 
equation in vector form. For details on this identification see for instance |16] . Let X denote 
the unique vector (ni, n2, 71-3) with X = X{n). Then, the above equation can be rewritten as 



X'^ = - g'\^Xe + Y,^i(9,y)ei. 



i=l 



Now, consider the left-invariant function B = g (3 = g 563. Its first-order approximation reads 
B^{I-{X- X))e3 = (/ - Xe)e3 = (-6,6, 1)^, where X = (6,6,6)^- Choosing the left- 
invariant observer gains Li{g, y) = In ( B, g^i> ) — li2 { B, cf^T ) = In^i + /j2?2 with constants 
lij G M, i = 1, 2, 3, j = 1, 2, one obtains the system 

X'e 

which is time-invariant for /21 = —^12 = i^g- Based on this assumption, the coefficients of the 
corresponding characteristic polynomial 

piX) = X'- {122 + hi) X' + {klP + P\ll22 + 1) 4 - f ^ + ^^1 

P^ \P^ P J 




can be assigned by a suitable choice of In, I22 < 0, /31, and hence, local asymptotic convergence 
of the observer error can be achieved. 

6 Conclusion 

An invariant tracking control design for the kinematic car on the sphere has been proposed. 
Using a Lie group framework and basic geometric considerations, the left-invariant models on 
SE{2) for the planar case and on S0{2>) for the spherical case can be related in a straightforward 
manner. 
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